#include "hcsr04.h"

sbit TRIG=P2^0;
sbit ECHO=P2^1;

void init_timer0()
{
	TRIG=0;
	ECHO=0;
	TMOD|=0X01;
	TMOD&=0XFD;
	TH0=0;
	TL0=0;
	TR0=0;
	EA=1;
	ET0=1;
}


void getDistance()
{
	uint32 now=0;
	uint8 dis=0;
	TRIG=0;
	wait_time(2);
	TRIG=1;
	ECHO=0;
	wait_time(10);
	TRIG=0;
	while(!ECHO);
	TR0=1;
	while(ECHO);
	TR0=0;
	dis=((TH0 * 256 + TL0) + 1)/58;
	TH0=0;
	TL0=0;

	send_byte('f');
	send_byte(':');
	send_byte(dis/10%10+'0');
	send_byte(dis%10+'0');
	send_byte('\0');
	
}


void wait_time(uint8 num)
{
	for(;num>0;num--)
	{
		_nop_();
	}
}


